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Abstract 


This  report  presents  a  rigid  body  analysis  of  the  dynamics 
of  a  shipboard  antenna  in  a  three-axis  gimbal  configuration 
utilizing  Direct  Mechanical  Stabilization  (DMS)  for  primary 
control.  System  parameters  are  defined  and  Euler  equations 
applied  to  obtain  a  non-linear  system  model  that  includes 
expected  torque  inputs.  A  computer  simulation  is  generated 
with  ship  input  motions  due  to  roll,  pitch,  turn  and  flexure 
and  a  numerical  integration  procedure  is  then  employed  to 
determine  the  motion  of  the  antenna  and  the  resulting  pointing 
error  for  various  scenarios. 

The  results  of  the  cases  studied  indicate  potential  feasi¬ 
bility  of  this  approach  for  applications  requiring  pointing 
accuracy  of  approximately  +0.15  degree* 
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1.0  INTRODUCTION 


This  ii  he  rigid  body  analysis  of  a  DMS*-con trolled 
antenna  on  board  a  surface  ship  for  a  three-axis  gimbal  con¬ 
figuration  employing  X-Y  over  train.  The  combined  effects  of 
roll,  pitch,  turn  maneuvers  and  ship  flexure  on  the  pointing 
accuracy  of  the  antenna  are  studied. 

1 . 1  Background 

The  gyroscope  has  found  its  most  prolific  application  in 
modern  technology  as  an  angular  direction  and  motion  sensor 
whose  electrical  output  signal  is  used  to  activate  either  a 
mechanical  or  computational  device.  However,  throughout  the 
last  half  century  of  very  active  development  and  refinement  of 
these  sensors  of  shrinking  size,  there  has  been  a  lower  level 
but  continuing  effort  on  large  gyro  wheels  for  DMS .  The  most 
sophisticated  effort  on  DMS  in  recent  years  has  been  associated 
with  the  use  of  control  moment  gyros  for  stabilization  and  atti¬ 
tude  control  of  satellites. 

There  are  two  general  approaches  to  the  concept  of  DMS : 

1)  Mount  the  stabilized  device  directly  to  the  frame  carrying 

the  gyro  rotor.  This  assembly  is  then  mounted  within  gimbals 

and  bearings  to  permit  angular  isolation  from  input  motion. 

Examples  of  this  approach  are  found  in  both  early  and  more 

recent  literature.  Scarborough^1'  describes  the  gyro  pendulum; 

Williams  analyzes  stabilization  of  an  optical  sensor  for  a 

( 4 ) 

shipboard  application;  Bieser  describes  a  configuration  of 
this  type  for  stabilizing  an  antenna  on  board  a  ship. 


* 


Direct  Mechanical  Stabilization 


In  this  general  approach  the  gyro  spin  axis  a  id  the  stabil-' 
ized  device  (optics,  antenna,  etc.)  move  together  as  the  gyro 
precesses  in  response  to  disturbing  torques. 

2)  In  the  second  general  approach  the  gyro  rotor  spin  assembly 
is  mounted  to  the  stabilized  frame  within  a  pivot  axis  that  is 
orthogonal  to  the  spin  axis.  This  is  a  distinct  improvement  i.i 
stabilizing  effectiveness  over  the  first  type  described  in  V 
above.  Now  the  primary  effect  of  any  disturbing  torque  on  the 
stabilized  device  is  to  cause  only  the  gyro  to  precess  within 
its  pivot  axis.  The  stabilized  frame  remains  essentially  undis¬ 
turbed  while  the  gyro  precesses.  This  method  has  been  used  since 
the  beginning  of  the  century  on  examples  such  as  the  Schleek  ship 
stabilizer  in  1903  ^  and  the  monoraiJ  stabilizer  of  Scherl  and 
Schilorsky  in  1909  ^.  More  recent  examples  are  Bieser's  antenna 
stabilizer^,  Matthews  version  of_  a  similar  device1^  and  an 
aircraft  camera  stabilizer  development  oy  Kestinghouse  Canada 
Limited  ^  . 

The  dynamics  of  the  Bieser  approach  have  recently  been 
f  8 ) 

analyzed  .  This  configuration  utilizes  the  DMS  principle  to 
provide  a  roll-pitch  stabilized  platform  carrying  a  train- 
elevation  servo-controlled  antenna. 

The  X-Y  configuration  described  in  this  report  applies  the 
second  general  approach  to  directly  position  and  stabilize  the 
antenna  without  an  intermediate  train-elevation  servo. 

1 . 2  General  Description 

Figure  1  is  a  pictorial  representation  of  the  hardware  con¬ 
figuration  showing  the  antenna  in  a  horizontal  beam  position, 
mounted  to  the  stabilized  structure  containing  the  'A'  and  'B' 

DMS  gyro  assemblies.  The  first  gimbal  axis  supporting  the 
stabilized  assembly  is  the  Y  axis  which  is  nominally  controlled 
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to  be  in  the  vertical  plane  containing  the  satellite;  the  next 
supporting  a.vls  is  the  X  axis  which  is  nominally  controlled  to  be 
perpendicular  tc  the  vertical  plane  containing  the  satellite.  The 
total  assembly  is  carried  on  the  train  axis  which  is  mounted  to 
the  deck  or  the  ship. 

further  detail  is  given  in  Figure  2  where  the  antenna  is 
shown  in  a  vertical  beam  position.  The  * A*  gyro  is  free  to  pivot 
about  an  axis  parallel  to  X  and  the  'B'  gyro  is  free  to  pivot 
abouu  an  axis  parallel  to  Y.  The  gyro  pivot  axes  and  the  X,  Y 
cirabal  axes  are  each  equipped  with  a  torquer  and  angular  pickoff. 
The  tram  axis  is  positioned  by  a  stepper  motor,  and  has  a  pre¬ 
cise  angular  pickoff  to  read  its  position. 

Antenna  beam  position  control  is  achieved  by  applying  appro¬ 
priate  control  torques  to  the  'A'  or  '  B*  gyro  torquer.  For 
example,  antenna  faction  about  the  X  axis  is  achieved  by  applying 
a  torque  to  the  '  B'  gyro  torquer.  The  antenna  is  stabilized 
against  the  effects  of  disturbing  torques  by  precession  of  the 
gyro  assemblies  within  their  respective  pivot  axes.  Narrow  band- 
widt.n  caging  loops  are  used  to  maintain  the  spin  axes  nominally 
parallel  to  the  antenna  beam  axis.  For  example,  the  X  torquer 
responds  to  a  pickoff  signal  from  the  ' B'  gyro  to  null  the  'B' 
gyro  pickcff  output. 

The  details  of  the  control  concepts  will  be  explained  in  the 
body  oi  this  report. 


2.0  KINEMATIC  FRAMES  &  EULER  ROTATIONS 


Referring  to  Figure  3,  the  following  reference  frames  and 
their  Euler  rotations  are  defined: 


{n} 

= 

inertial  frame 

{£} 

= 

deck  frame 

- 

antenna  platform 

{a} 

= 

'A'  gyro  gimbal 

{£} 

'B'  gyro  gimbal 

{e} 

- 

frame  containing  satellite  position  along  e „ 

ta> 

= 

X-Y  gimbal  frame 

ional 

intermediate  reference  frames  are  defined 

below  in 

;  of 

the  angles  of  rotation  and  the  axis  of  each 

rotation 

*A 

= 

ship  azimuth 

= 

pj  tch 

= 

roll 

= 

heei  (¥rh  =  bR  +  VH) 

6t 

= 

train 

6x 

= 

X  axis 

0Y 

= 

Y  axis 

Ya 

= 

gyro  'A'  gimbal  rotation  with  respect  to 

platform 

Yb 

= 

gyro  'B'  gimbal  rotation  with  respect  to 

platform 

= 

satellite  azimuth  position 

aE 

= 

satellite  elevation  position 
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SATELLITE 


Fig.  3.  X-Y  DMS  kinematic  frames. 


The  format  for  showing  the  rotation  sequences  are: 


starting  |  Rotation  Angle  (frame  after 


frame 


Rotation  Axis 


rotation 


Applying  this  format  and  the  previously  defined  frames  and  rota¬ 
tion  angles  the  rotation  sequences  are  as  follows : 

A 

Deck  of  Ship  (f } 


(A) 


{n*  } 


A 

—3 


Hi 


{n"  } 


RH 


A 

-►  (f  > 


M  i) 
~2 


Antenna  Platform  (£j 


0 


{£} 


T 

- ►  {f'  ) 


A 

-3 


-i 


A 

23 


,  A 

{E} 


'A'  Gyro  (a) 


-*►  {£} 


A 

Hi 


8 


L 


'B*  Gyro  {b } 


Gimbal:  u>b  =  u>bl  bx  +  w b2  b2  +  u>b3  b3 

Rotor:  «b  =  u)bl  ^  b2  +  *b3  b3 


(3-7) 

(3-8) 


Note  that  the  polarity  of  fib  b2  is  negative.  This  is  essential 
to  assure  that  both  rotors  precess  in  the  same  direction  with 
the  antenna  when  a  control  torque  is  applied  to  either  rotor. 

For  example  the  torquer  used  to  control  X  axis  motion  applies  a 

A 

torque  to  the  'B'  gyro  about  b3  and,  via  reaction,  an  opposite 

J  A 

polarity  torque  to  the  'A'  gyro  about  a...  Both  rotors  then 

A  J  A 

precess  in  the  same  direction  about  b.  and  a.  respectively  while 

a  1 

the  antenna  moves  about  £^. 

Note  that  v,  =  uj,  ~  — txj 

b  b3  p  3 


4 

H 

4 


-j 
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E  VARIABLES 

following  state  variables  are  defined  for  the  system 
that  will  be  developed: 


00 


al 


00 


b3 


00 


P3 


00 


pi 

P2 


/y.dt 

a 

/Ybdt 
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5. 0  GYRO  EULER  EQUATIONS 

The  Euler  equations  for  the  gyros  are  developed  in 
Appendix  A  and  result  in  the  following  relations: 


“al 

—  vJ  m  + 

al 

(5-1) 

“a3 

=  «J  ~  + 
a3 

**2/Zg2 

(5-2) 

“bl 

=  Jbi  + 

Tbl/Tgl 

(5-3) 

“b3 

=  Jb3  + 

Tb3/:Cg3 

(5-4) 

Jal 

=  wa3na 

Ig2/Igl  "  “a3“a2 

Ja3 

=  -w  .  ft 

al  a 

1g2/Igl  +  “al“a2 

Jbl 

=  _ij,b3nb 

Ig2/Igl  '  “b3wb2 

Jb3 

=  “bl^b 

Ig2/Igl  +  “bl“b2 

Jgi' 

Ig2  =  gyro  assembly  inertia  about 
of  {a}  or  {b} 

1  and  2  axes 

Tal' 

Ta3/  Tbi '  Tb3  =  torgue  applied  to 

gyro  about 

subscript  axis  (see  Eq.  (9-6)  and  (9-12)) 
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6 , 0  PLATFORM  EULER  EQUATIONS 

•The  platform  Euler  equations  are  developed  in  Appendix  A 
and  result  in  the  following  relations: 

(6-1) 
(6-2) 

(6-3) 

where 

T  =  torque  applied  to  platform  about  j  axis 
(see  Eq.  (9-20) ) 


WP1  Tpl/;i:pl 

UJp2  =  Tp2/Xp  2 

"P3  *  W1^ 


7 . 0  CONSTRAINTS 

Mechanical  constraints  ex^  t  due  to  the  gimbal) ing  config¬ 
uration.  The  angular  velocity  e^tions  that  rer  rve  these 
constraints  are  developed  in  Appendix  B  with  the  l^llowing 
results : 


“a2 
ua3  = 
wbl 
wb2  = 


WP2 

cos 

Ya 

+ 

-P3 

£  n 

Ya 

_U)p2 

sin 

Ya 

+ 

Wp3 

cos 

Ya 

U)  , 

pi 

cos 

Yb 

+ 

WP2 

sin 

Yb 

-w  . 
pi 

sin 

Yb 

+ 

<up2 

cos 

Tb 

(7-1) 

(7-2) 

(7-3) 

(7-4) 
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8.0 


TRANSFORMATIONS  AND  CONTROL  OF  6  , 


8.1  Transformation  for  9  ,  and  0 


The  antenna  beam  lies  along  axis  £2;  the  satellite  position 
vector  lies  along  e^.  We  desire  to  orient  £2  coincident  with  e2 
using  the  rotations  defined  in  Section  2.0  to  determine  appro¬ 


priate  input  command  angles  and  0  as  functions  of  a  ,  a_, 

r  c  xc  yc  A  E 

,  'J' ,  ^DU ,  0-.  The  computation  process  determines  the  (n) 

A  p  Kii  1  ^  ' — 

components  of  £2  and  then  equates  these  components  to  solve 

for  0  and  0 

xc  yc 

The  direction  cosine  matrices  for  the  rotations  in  Section 
2.0  are  defined  using  the  symbols. 


[C. (O ]  =  Direction  cosine  matrix  for  rotation 

1  4-  H 

about  i ^  axis  of  starting  frame 
through  the  angle  5. 


Using  this  notation  the  relations  between  various  reference 
frames  are  defined  as  follows: 


{f1}  =  [c3(eT)][c2(^RK)][c1(^p)][c3(^A)]{n} 

{f*  }  =  [Bjfn} 


(8-1) 


"  [C3(eyc)1[Cliexc^{i'} 
{£}  =  [B2]  {f  •  } 
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From  (8 


From  ( 8 


{i}  =  [Cx(Ya)]{£} 

<£>  =  (C3(Yb)]{£} 

{£}  =  [C1«xE)  ]  [C3(aA)  ]  {n} 
=  t  B  3 ] (n) 

1)  and  (8-2) 

{£>  =  [B2B1 ] (n  > 

{n}  =  B2  {£} 


{e} 


A  A  A 

The  n  components  of  jb_  and  e2  are  now  equated  using  (8-6)  and 


The  expansion  and  solution  of  Eq.  (8-8)  for  the  desired  angles 
is  performed  in  Appendix  C  with  the  following  results: 


0yc  =  sin  1(-t1J  (8-9) 

0XC  =  sin_1(t3/cos0yc)  (8-10 


where 


t^,  t3  =  results  of  matrix  equation  (C-3)  in 
Appendix  C. 


8 . 2  System  Control 

The  control  approach  that  will  be  used  to  achieve  the 

desired  values  6  .  9  is  shown  in  Figures  4  and  5. 

xc  yc  3 

Referring  to  Figure  4,  the  command  values  6XC/  6yc  ate 
compared  to  actual  values  measured  by  the  X,  Y  pickoffs  and 
the  error  signals  drive  the  appropriate  gyro  torquers.  A 
train  command  based  on  ship's  heading  and  satellite  position 
(see  Figure  5  and  Section  8.3)  drives  the  train  stepper  motor. 
The  bottom  loop  shown  in  Figure  4  is  a  'housekeeping'  loop  that 
keeps  the  gyro  spin  axis  nominally  parallel  to  the  antenna  Deam 
axis. 

Figure  5  shows  the  flow  of  information  used  to  generate 
the  control  commands.  The  ship's  master  compass  and  heading 
reference  provide  roll,  pitch  and  heading  information  used  in 
the  coordinate  transformations.  The  heading  output  of  the 
compass  is  also  utilized  directly  to  position  the  train  servo. 
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X, Y  POSITION  LOOPS 


TRAIN  POSITION  LOOP 


GYRO  CAGING  LOOPS 


Note:  There  is  no  active  stabilization  loop.  The  gyros 

PROVIDE  THIS  FUNCTION. 

Fig.  4.  X~Y  DMS  control  outline. 
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Fig.  5.  X-Y  DMS  commands. 


The  satellite  ephemeris  data  is  updated  by  down-link  tracking 
error  signals  to  provide  the  desired  antenna  beam  position  to 
the  satellite.  The  coordinate  transformation  computation  gen¬ 
erates  the  desired  values  6  ,  0  based  on  the  inputs  shown. 

xc  y  c 

The  basic  stability  of  the  DMS  gyros  permits  a  narrow  band¬ 
width  control  from  the  command  signals  to  the  gyro  torquers. 

This  attenuates  or  filters  the  effect  of  high  frequency  ship 
flexure  on  the  controlled  output.  Long  term  flexure  due  to 
thermal  effects  or  loading  are  corrected  by  the  down-link  track¬ 
ing  error. 

8.3  Train  Axis  Control  of  9m 

—  ...  ...  ~  1 

The  purpose  of  the  train  axis  is  to  nominally  position  the 
Y  axis  in  the  vertical  plane  containing  the  satellite.  This  is 
not  a  critical  requirement  and  so  it  is  expected  that  an  inex¬ 
pensive  stepper  motor  will  be  used  in  train.  For  the  purpose 
of  modelling,  the  following  damped  second  order  system  has  been 
assumed  in  train: 


8  +  2u  C 8  +  u)^8  = 

n  n  n  A 


(8-11) 


where 


=  *A  +  0T 

=  natural  frequency  of  train  servo 


=  damping  factor 
=  azimuth  position  of  satellite 


. 


Making  the  substitution  for  g  as  indicated  above  leads  to  the 
defining  equation  for  8^. 

®T  +  2iV  ®T  +  wneT  =  F  *8-12) 

where 

F  .  -*A  -2^nt»A  *  »*«VV 

9. 0  TORQUE  EQUATIONS 

In  this  section  the  torque  contributors  that  produce  the 
system  response  are  defined  for  computational  purposes: 

9 . 1  Gyros  'A'  and  'B'  Torques 
Spring 
Friction 
Unbalance 
Bias 
Control 

Bearing  Reaction 
Total 
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Platform  Torques 
Spring 
Friction 
Unbalance 
Bias 

Gyro  Reaction 
Bearing  Reaction 
Control 
Total 


9 . 2  Gyro  'A*  Torques 
9.2.1  Spring 

An  elastic  spring  torque  due  to  rotation  of  the  'A' 
gyro  about  its  pivot  axis,  a^  is  modelled. 


T 

—as 


"KsGYa-l 


(9-1) 


where 


KgG  =  gyro  spring  gradient 

9.2.2  Friction 

Friction  about  the  pivot  axis  is  modelled  as  a  constant 
magnitude  torque  with  a  polarity  that  opposes  the  relative 
angular  velocity  of  the  'A'  gyro  with  respect  to  the  platform. 
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(9-2) 


where 


-aF  "  KFG^a/^a^  -1 


KFG  =  gyro  friction  torque  amplitude 


9.2.3  Unbalance 

Torque  about  the  pivot  axis  due  to  unbalance  has  been 
modelled  as  a  displacement  along  the  rotor  spin  axis,  ^ •  coupled 
with  transverse  acceleration  components.  Unbalance  torque  due  to 
radial  displacement  along  a^  has  been  assumed  to  be  insignificant 
in  recognition  of  the  fact  that  radial  stability  of  balance  is 
much  better  than  axial  stability.  See  Appendix  D  (Eq.  (D-14) ) 
for  development  of  this  expression. 


^au  =  ~m*g [-A2sinYa  +  A3cosYa]  ax  (9-3) 

where  m  «  gyro  mass 

~  displacement  of  gyro  mass  center  from  center 
of  support  along  a3 

A2,A3  =  acce^erati°n  components  along  and  E3 
respectively 

9.2.4  Bias 

Bias  torque  has  been  modelled  about  the  pivot  axis. 
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where 

TaR  =  bias  torque  value 
9.2.5  Control 

Referring  to  Figure  3,  the  control  torque  on  the  'A'  gyro 
is  exerted  about  the  pivot  axis  a^  to  correct  for  Y  axis  error 
as  indicated  by  the  difference  between  the  command  value /  0y c, 
and  the  actual  value,  0^.  Recall  from  Figure  5  that  the  command 
angle  computation  is  degraded  by  ship  flexure  between  the  master 
attitude  reference  and  the  deck  at  the  antenna.  A  conservative 
worst-case  situation  is  modelled  with  the  full  ship  flexure 
amplitude  introduced  into  the  control  equation. 


T  =  -K  (6  -e 
-tea  a'  yc  y 


V 


A 


(9-5) 


where 


K  =  control  gain  (in-lb/rad) 

ct 

0_  »  ship  flexure  amplitude  (rad) 
r 


9.2.6  Bearing  Reaction 

Radial  forces  at  the  pivot  bearings  introduce  torque 
about  a2  and  a3>  The  component  about  a2  has  no  significant 
effect  since  a2  is  along  the  spin  axis  of  the  rotor.  Accord 
ingly,  the  torque  due  to  bearing  reaction  is  defined  as: 


(9-6) 
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=  magnitude  of  bearing  reaction  torque  (in-lb) 


where 

9.2.7  Total  Torque  on  'A*  Gyro 
The  total  torque  on  the  'A'  gyro  is 


la  =  Tal  k  *  Ta2  *2  +  Ta3  ^3 


where 


T  ,  a.  -  T  +  T  _  +  T  +T„  +  T. 
al  —1  —as  — aF  — au  — aB  — cA 


Ta2  =  0 


(9-7) 


9. 3  Gyro  'B*  Torques 

The  torques  acting  on  the  ’B'  gyro  are  similar  to  those  on 
the  'A'  except  for  different  axes  and  a  geometric  consideration 
applied  to  the  control  torque. 

9.3.x  Spring 


_KsGYb  -3 


9.3.2  Friction 


(9-8) 


(9-9) 
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9.3.3  Unbalance 


-bu  =  “mig  [A1co8Yfa  +  A28inYb]  ^  <9-10) 

See  Eq.  (D-19)  in  Appendix  D. 


9.3.4  Bias 


-bB 


TbB  -3 


(9-11) 


9.3.5  Control 


^cb  =  “V0xc  -0x  +  0F)coa0y  —3 


(9-12) 


Note  that  the  control  torque  is  responsive  to  the  antenna 
error  signal  about  the  X  axis  with  ship  flexure  again  introduced 
as  a  worst-case  effect.  Any  displacement  in  Y  serves  to  increase 
the  X  rate  response  to  a  given  torque  input.  This  is  offset  by 
introducing  cosS^  into  Eq.  (9-12) . 

9.3.6  Bearing  Reaction 

Following  similar  arguments  to  that  in  9.2.6#  we  write 


-Rb 


Tbi  £i 


(9-13) 
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The  total  torque  on  the  'B'  gyro  is 


Tb  fei + 


where 


+  *bF  +  *bu  +  lbB 


+  2cb 


(9-14) 


9. 4  Platform  Torques 
9.4.1  Spring 

Spring  torque  acting  on  the  platform  is  a  function  of 

0  and  6  displacement.  Spring  torque  due  to  0_,  is  cancelled 
x  y  l 

out  by  the  stepper  motor. 


T  =  -k  [e  g.  +  0  p,l  (9- 

-ps  spl  x  *1  y  £3;  '  * 

where  Ksp  =  spring  gradient 
9.4.2  Friction 

Friction  is  modelled  as  a  constant  amplitude  torque  with 

a  polarity  in  opposition  to  velocities  0  and  §  . 

x  y 

— pf  -  -KFpHVi«xi»  ii +  'VV1  e3)  <9 
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9.4.3  Unbalance 


The  platform  unbalance  torque  ia  defined  in  Section  D-10 
of  Appendix  D  with  the  result  r  “  - 


Ipu  -  Tul  El  +  5'u2  e2  ♦  Tu3  e3 


where 


(9-17) 


Aul 

T  o 
u2 


u3 


M 


l. 

X 


9.4.4 


=  M(A2&3  -  A342) 

=  m(a3^1  -  a1&3) 

-  m(a1^2  -  a2£1) 

=  platform  mass 

=  displacement  of  mass  center  along  axis 
Bias 


IPB  "  tbx  El  +  TBy  E3  19 

where  t  ,  T_  =  bias  torque  about  X  and  Y  axes 
Bx '  By 

9.4.5  Gyro  Bearing  Reaction 

The  total  torques  acting  on  the  'A1  and  'B'  gyros  are 
defined  as  T  and  T.  in  Eqs.  (9-7)  and  (9-14)  respectively. 
These  are  primarily  reaction  torques  between  the  gyros  and  the 
platform  except  for  the  gyro  unbalance  torques  which  are  small. 
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Accordingly,  the  gyro  reaction  torque  acting  on  the  platform  is 
modelled  by: 


9.4.6  Control 

Torquers  on  the  X  and  Y  axes  are  used  to  cage  the  gyro 
spin  axes  by  nulling  y  and  y.  using  a  proportional  plus  integral 

a-  D 

control  loop. 


£pc  =  "Kpc(Yb  +  £3)  _KPI(/Ybdt  il  +  /Yadt  &3)  (9_20) 

where  K  =  direct  gain 

pc  ^ 

KpI  =  integrator  gain 


Note  that: 


/y^dt  =  X1Q  and  /y^dt  = 

9.4.7  Bearing  Reaction 

Radial  forces  at  the  X  and  Y  axis  bearings  generate  a 
torque  about  axis  £2*  We  define  this  term  as 


(9-21) 
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9.4.8  Total  Platform  Torque 

Sum  the  previously  defined  torque  contributions  to  deter¬ 
mine  the  total  platform  torque: 


Ip  -  Ips  +  IpF  +  Ipu  +  IpB  +  IrP  +  Ipc  +  SpO 


(9-22) 


or  in  terms  of  £  frame  components. 


Ip  -  Tpl  El  +  Tp2  E2  ♦  1p3  £3  (9 

10.0  SYSTEM  EQUATIONS 

The  system  equations  are  generated  in  the  Appendices  and 
are  summarized  below  followed  by  a  description  of  their  develop¬ 
ment  process. 


where 


Xj.  =  ex  =  (u)pl  -D^cosSy  -  y2sin0y) /cos0y 

D1  *  wficoseT  +  2s^n0T 

Y2  *  D2cosGx  +  (6?  +  u)f  3)  sin0x 

°2  =  "“'f  +  wf2cos0T 


(10-1) 


0..  “  w 


P3 


D2sin0x 


-(0T  +  O)f3)cos0x 


(10-2) 
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(10-10) 


X 


10 


Y 


a 


(10-11) 


(10-12) 


0T  =  -2V(0T  + 


*A> 


wn(aA  -0T  ’V 


(10-13) 


The  following  table  shows  the  source  of  development  of  the  system 
equations : 


Equation  (s) 

10-1,  10-2 
10-3,  10-4 

10-5,  10-6,  10-7 

10-8,  10-9 

10-10,  10-11 
10-12,  10-13 


Source 
Appendix  E 

Sect.  5.0  &  Appendix  A 
Appendix  F 
Section  3.0 
Equation  (9-20) 
Equation  (8-12) 
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11.0  COMPUTER  SIMULATION 


The  computer  program  based  on  the  preceding  analysis  is 
described  and  listed  in  Appendix  H. 

11.1  Parametric  Values 

Parameter  values  are  shown  below  for  two  cases.  The  vari 
able  designation  in  front  of  each  corresponds  to  that  used  in 
the  computer  simulation. 

Case  Is  Ship  rolling  and  flexing 


Case 

2: 

Ship  rolling,  pitching 
No  flexing  included. 

and  turning 

at  high  speed 

Case  1 

Case  2 

D{1) 

= 

Desired  Azim  (Deg) 

0 

0 

D(2) 

= 

Desired  Kiev  (Deg) 

57. 3 

57.3 

D(3) 

= 

Roll  Amplit  (Deg) 

20.0 

20.0 

D  (4 ) 

- 

Pitch  Amplit  (Deg) 

0 

10.0 

D(5) 

= 

Flex  Amplit  (Deg) 

.  5 

0 

D(6) 

= 

Roll  Period  (Sec) 

10.  0 

10.0 

0(7) 

= 

Pitch  Period  (Sec) 

- 

15.0 

D(8) 

= 

Flex  Period  (Sec) 

1.0 

- 

0(9) 

= 

Roll  Height  (In) 

1200. 0 

1200. 0 

D(10) 

= 

Velocity  (Knots) 

0 

20.0 

D(ll) 

= 

Turn  Rate  (Deg/Sec) 

0 

3.0 

D  ( 1 2 ) 

- 

Heel  Angle  (Deg) 

0 

0 

D  <13 ) 

- 

Cant  Angle  (Deg) 

0 

0 
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3 


D(14)  =  WN  Train  Servo 

{ Rad/Sec) 


3. 


D(15)  =  Damping  Ratio 

Train  Servo 


.7 


.  7 


The  values  below  were  used  in  both  cases: 


E(l) 

se 

Platform  Mass  (Lb-Sec2/In) 

0.25 

E  (2) 

= 

Gyro 

Mass  (Lb-Sec^/In) 

0.06 

E  ( 3 ) 

= 

Gyro 

Mass  Offset  (In) 

0.003 

E  (4) 

= 

Plat 

1  Mass  Offset  (In) 

0.003 

E  ( 5) 

= 

Plat 

2  Mass  Offset  (In) 

0.003 

E  (6 ) 

= 

Plat 

3  Mass  Offset  (In) 

0.003 

E  ( 7 ) 

= 

Gyro 

Friction  (In-Lb) 

0.04 

E{8) 

= 

Gyro 

Spring  (In-Lb/Rad) 

0.20 

E  (S) 

s 

Gyro 

A  Control  Gain  (In- Lb/Rad) 

108. 0 

E  (10) 

= 

Gyro 

B  Control  Gain  (In- Lb/Rad) 

108.0 

E  (11) 

* 

Platform  Friction  (In-Lb) 

0.5 

E  (12) 

= 

Platform  Spring  (In-Lb/Rad) 

1.5 

E  ( 13) 

= 

Gyro 

Inertia  1  and  3  (Lb-In-Sec2) 

0.  5 

E  ( 14 ) 

= 

Gyro 

Inertia  2 

1.0 

E  (15) 

= 

Flatform  Inertia  1 

40.0 

E  (16) 

= 

Platform  Inertia  2 

30.  0 

E  (17) 

= 

Platform  Inertia  3 

40.  0 

E  (18) 

— 

Gyro 

Spin  Speed  (Rad/Sec) 

361-0 
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E  (19 )  =  Platf  Contr  Gain  (In-Lb/Rad)  50.0 

E  ( 20 )  =  Platf  Torq  Integr  Gain  (In-Lb/Rad-Sec)  5.0 

E (21)  =  Gyro  A  Torque  Bias  (In- Lb)  0 

E  (22 )  =  Gyro  B  Torque  Bias  (In-Lb)  0 

E(23)  =  Plat  Elev  Bias  Torque  (In-Lb)  0 

E  (24 )  =  Plat  Cross  Elev  Bias  (In-Lb)  0 

E  ( 25 )  =  Limit  on  Gyro  Torquer  (In-Lb)  5.0 

E(26)  =  Gyro  Speed  Mismatch  0 


11.2  Initial  State  Values 

In  both  cases  the  system  is  initialized  with  the  antenna 
pointing  at  the  satellite  (X. (0)  =6(0)=  1.  radian; 

X 

D(2)  =  a.  =  57.3°)  and  with  a  body  rate,  w  ,,  necessary  to 

A 

match  the  £2  component  of  the  ship's  roll  rate. 

Results 
Case  1 

Figure  6  shows  a  plot  of  the  X  and  Y  axis  error  over  a 
period  of  75  seconds.  The  error  is  the  difference  between  the 
computed  command  angle  and  the  actual  angle  determined  by  the 
integration  process.  Figure  7  shows  the  motion  of  the  'A'  and 
'B'  gyros  about  their  pivot  axes  during  the  same  period.  There 
are  two  aspects  of  the  response  to  be  examined. 

The  ±0.5  degree  ship  flexure  input  is  attenuated  to  approx¬ 
imately  ±0.02  degree  of  X-Y  error  by  the  narrow  bandwidth  trans 
fer  function  of  the  overall  system. 

The  roll  input  with  a  10-second  period  causes  oscillations 
at  that  period  in  the  X-Y  error  and  the  'A'  gyro  motion.  The  'B 
gyro  shows  a  double  frequency  response  with  a  5-second  period. 
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ANGLE  (DEG. 


TR- 562 ( 7 ) 


X76  22:20  80/309  2 


Fig,  7.  x-Y  DMS  gyro  motion  (rolling). 
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After  an  initial  transient  a  steady  state  response  is  achieved 
in  approximately  30  seconds  with  an  X-Y  error  averaging  less 
than  0.05°. 

Case  2 

Figures  8  and  9  show  the  X-Y  errors  and  the  gyro  motion  over 
a  90-second  period.  This  is  a  more  confused  dynamic  environment 
than  in  Case  1  and/  accordingly/  we  see  a  more  confused  response 
in  Figures  8  and  9. 

After  an  initial  transient  a  general  steady  state  band  of 
response  is  achieved  in  approximately  60  seconds  with  an  average 
X-Y  error  of  less  than  0.1  degree. 


i  k 


■  J  I 


ANGLE  (DEG ) 


TR-562 { 8 ) 


X76  22 '.09  80/339  I 


Fig.  8.  X-Y  DMS  error  (roll,  pitch,  turn). 
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X76 

r~r — i — i — i — i — i — i — i — i — i — i — i — r 

"  ROLL:  *20°,  10  SEC  PER 
"  PITCH:  110°,  15  SEC  PER 
_  SPEED:  20  KNOTS 
"  TURN  RATE:  3°/SEC 
"  ROLL,  PITCH  HEIOHT:  100  FEET 
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00 
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T  l  SEC 


Pig.  9.  X-Y  DMS  gyro 
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APPENDIX  A 
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(A- 2) 


Combine  (A 


After  some 
leaving : 


at  *  “al  il  +  “a3  *3 

•1)  /  (A—  2 )  and  the  terms  defined  above  to  get 


1/1 


gi 

0  1/1 


g2 

o  l/I 


gi 


0 

<0 

3 

1 

a2 

0)  , 

a3 

0 

-U>  , 

al 

-cd  - 
a2 

al 

0 

•gi 

o 


g2 

o 


i/i 


gi 

o  l/I 


g2 

0  l/I 


0 

0 

Igi 

0 

0 


gi 


al 


fi 


oj 


a3 


al 


a2 


a3 


algebra  the  second  of  the  (A- 3)  equations  vanishes 


al  =  1/1<jl  t“a3naIg2  "u,a2wa3Igl  +  Tal] 
a 3  "  1/Igl[wa2l0alIg.l  'walVg2  +  Ta3] 


(A- 3) 


(A-4) 


(A- 5) 
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which  can  then  be  put  into  the  form  of  Eqs.  (5-1)  and  (5- 


2) 


“«1  -  Jal  + 


=-(  5-1) 


where 


“a3  =  Ja3  + 


Jal  *  -  “aiV'V 


J.3  *  “a1<-V,2  +  “a2Igl)/'I9l 


2.  Gyro  '  B' 

The  development  of  Eqs.  (5-3)  and  (5-4)  for  the  ’s'  gyro 
is  similar  starting  with 


(5-2) 


u 

j  : 


*  d 


ai  <£t'  =  ♦  i;1  ib 


(A- 6) 


3.  Platform 


The  Euler  equations  for  the  platform  are 


%>  *  -Ip^pUpHp  *  Ip 


(A- 7) 


where 


£!p  =  “pi  El  +  “p2  E2  +  “P3  E3 


*pl 

0 

0 

h = 

0 

I  -> 

P2 

0 

in  £  frame 

0 

0 

Jp3_ 

0 

-0)  - 
p3 

"p2 

II 

0. 

i  3 

P3 

0 

‘"pl 

-w  ^ 
p2 

"pi 

0 

A 

A 

A 

(9 

T  =  T 

-p 

pl  Ei 

+  TP2 

E2  +  1 

P3 

e3 

There  are  no  gyroscopic  terms  in  (A-7)  since  the  platform 
motions  are  relatively  slow,  therefore  expansion  of  (A-7)  leads 
to 

2p  =  V  El  +  V  E2  +  “P3  E3  (a 

where  ipl  =  Tpl/Ipl 

wp2  =  Tp2/1p2 

wp3  =  Tp3^Ip3 


Equations  (A-9)  are  Eqs.  (6-1),  (6-2),  (6-3). 


APPENDIX  B 


CONSTRAINTS 


The  angular  velocities  of  the  (a)  and  (to)  frames  are  con¬ 
strained  to  that  of  the  {£}  frame  by  the  gimbal  arrangement 
shown  in  Figure  3. 


Consider  the  {a}  frame  which  pivots  about  a^.  The  compo¬ 
nent  is  not  constrained;  however,  and  are  by  the 

equality  of  the  vector  sums: 


a)a2  -2  +  wa3  -3  =  wp2  ^2  +  wp3  ^3 


(B-l) 


Using  the  relations  defined  in  Section  2.0  we  can  write 


{a}  =  (C^)  ]  {£} 


1 

0 

0 


0 

COSY  , 

u 

-sinva 


0 

sinYa 
cosy  = 

a 


( 0 

j  wp2COSYa  + 

l-a)p2sinYa  + 


P3 


P2 


siny 

cosy 


a 

a 


) 


(B-2) 


Combining  (B-l)  and  (B-2)  we  get  the  equations 


|o>> 


“a2  =  “P2COSYa  +  u,P3sinYa 


(B-3) 


wa3  "  "“p2sinYa  +  “p3COSYa 


(B-4) 


Equations  (B-3)  and  (B-4)  are  Eqs.  (7-1)  and  (7-2).  Similarly 

A 

for  frame  {b}  which  has  a  single  degree  of  freedom  with  respect 
to  {£}  about  axis  b3  we  get 


“bl  -1  +  “b2  —2  "  “pi  £l  +  “p2  E-2 


(B-5) 


A 

{b} 

“  [C3 

(Yb) 

]  {£) 

cosYb 

sinYb 

0 

(Wpl)  1 

1  wplCOSYb  + 

“P2sinYbj 

-sinYb 

cosYb 

0 

rp2( 

-u,pisinYb  + 

“P2cosYb[ 

0 

0 

1 

(  0  )- 

k  0 

) 

“bl  =  “plCOSYb  +  “p2sinYb 
%2  =  ”“plsinYb  +  “p2COSYb 


Equations  (B-7) 


and  (B-8)  are  Eqs. 


(7-3)  and  (7-4). 


(B-7) 


(B-8) 


46 


APPENDIX  C 


TRANSFORMATIONS  FOR  8  AND  8 
- xc - yc 

In  this  appendix  we  expand  Eq.  fR-8)  and  solve  the  results 
for  8  and  8 


T  T 

BI  *2 


=  b: 


(8-8) 


The  unknowns  8XC  and  8yc  are  contained  in  B2  and  so  we  premulti¬ 


ply  by  B^  to  get 


B2  {  1  =  B1B3  1 


(C-l) 


Expand  the  left  side 


'Cl(8xc) JT[C3  <0yc> )T 


1 

0 

0 

cosV 

-sin6 

yc 

0 

0 

cos8 

xc 

'sin0xc 

sin9y= 

COS0 

r  v-  yC 

0 

0 

sinQ 

xc 

cos9xc_ 

0 

0 

1 

-sine 

yc 

cose 

cos6 

xc 

yc 

sinG 

cosu 

xc 

yc 

Expand  the  right  side  of  (C-l) 


l  0  1 


tc3(9T)  3  tC2(';,RH)  ]  tCl(V  1  tC3(V]  fCl(aA)  ]T 


0 

1 

0 


(C-3 


The  t^  terms  will  be  determined  by  numerical  computation  of 
(C-3) •  Then  equate  the  first  and  third  components  of  ( C—  2 )  and 
(C-3) . 
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APPENDIX  D 


ACCELERATION  VECTOR  &  TORQUE  DUE  TO  UNBALANCE 


We  consider  accelerations  due  to  the  following  sources 

a)  Roll  (horizontal  component  along  n|) 

b)  Pitch  (horizontal  component  along  n^) 

c)  Gravity  (vertical  along  n^) 

d)  Turn  (horizontal  component  along  n^) 

Roll  Acceleration  (horizontal  component  along  np 


— R  =  H  *r  i[ 


(D-l) 


where 


^R  =  "wR^ROsinuRt 


H  =  roll  height 


oop  =  roll  frequency 


=  roll  amplitude 


2.  Pitch  Acceleration  (horizontal  component  along  n!,) 


-P  H  —2 


(D-2) 
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0 

where  ty  =  -oj  \p  _sinw  t 

rp  P  PO  p 

=  pitch  frequency 
'J'  q  =  pitch  amplitude 
3.  Gravity  (along  nj) 


A  =  386  in/sec2'  n' 

3  J 


(d-3; 


Note  on  Polarity  of  A  : 

-g 

Force  due  to  gravity  acts  down  at  the  center  of 
mass.  Its  corresponding  support  force  at  the 
pivot  axis  is  positive  in  the  upward  direction. 
Torque  about  the  mass  center  results  when  the 
line  of  the  positive  support  force  does  not  pass 
through  the  mass  center. 

4.  Turn  (horizontal  component  along  n|) 


At  =  -v  w. 


T  -1 


(D-4) 


where 


V  =  velocity 
u)T  =  turn  rate 
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Total  Acceleration  in  {n* } 


We  add 

components 

above 

to  obtain 

A 

-  Ai  k  + 

A*  n' 

2  -2 

+  A3  "3 

where  A^ 

=H^r  -V 

T 

A2 

=  H  ip 

P 

A3 

=  386 

Transform  Acceleration  Vector  to  {£} 
We  transform  from  {n' }  to  {£}  using 


(D-5) 


=  [c3(0y)][C1(0x)][C3(0T)][C2(^R)]tC1(^  J]  {£•}  (D-  6) 


and  define  the  resulting  components  in  {£}  by 


A 


A 

El 


+  A, 


A 

E2 


+  A 


3  E3 


(D-?) 


7 .  Unbalance  Torque 

Unbalance  torque  due  to  the  combined  effect  of  acceleration 
and  displacement  berween  the  centers  of  support  and  mass  is 
defined  by  the  cross  product: 


57. 


where  a2  =  A2cosYa  +  A3sinYa 

a3  =  “A2ainYa  +  A3coaYa 
Now  consider 

S  -  k2 

_  ,  A  A  A 

F  =  m  A  —  m (A^  +  a2  a2  +  a^  a^) 

where  i  =  displacement  of  mass  center  from  support  point 

m  -  gyro  mass 

then  T  =  F  x  R  *  mi  (A,  a,  -a,  a,)  (D-13) 

The  a^  component  in  (D-13)  is  an  insignificant  bearing  reaction 
torque  which  can  be  neglected.  Therefore  using  the  definition 
of  a^  in  (D-12)  we  can  write 

-au  =  ~mZg <"A2sinYa  +  A3cosYa)  (D-14) 

9.  'B'  Gyro  Unbalance  Torque 

Transform  A  in  Eq.  (D-7)  from  {£}  to  {6)  using 

{b}  =  [C3(Yb) ]  {£)  (D-15) 
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<*>£  - 


cosY^  sinY^ 
■sinY^  cosY^ 


3e 


AaoosY]0  +  AjSinYjg 
•A.sinY.  -  A-cosY. 

1  D  &  D  I 


(D-16) 


Write  the  result  of  (D-16)  in  (b)  coordinates  as 


-  “  bl  -1  +  b2  -2  +  A3  -3 


(D-17) 


Now  consider 

£  -  lg  ii 

AAA 

F  *  m  A  ■  mfb-^  +  b2  b2  +  A3  £3) 

Then  Tbu  =  F  x  R  =  mi  (-b^  +  A3  b^)  (D-18) 

A 

We  neglect  the  b^  component  following  the  same  logic  that  pre¬ 
ceded  Eq.  (D-14).  Then  use  the  definition  of  b^  in  Eg.  (D-17) 
to  obtain 


Tbu“  ~mig  (A1C0SYj?  +  A2sinyb) 


(D-19) 
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10.  Platform  Unbalance  Torque 


Here  we  model  unbalance  about  all  three  axes  by  defining 


5  “  *1  El  +  *2  £2  +  *3  £3 


now 


T 

-pu 


=  F  X  R  =  M  (  Al£x  +  A2£2  +  A3£3)  X  (i^j.  +  £2£2  +  A3£3) 


-pu  “  Tul  ^1  +  Tu2  £2  +  Tu3  £3 


(D- 


where 


Tui 

-  m<V3  • 

A3£2} 

Tu2 

=  M(A3^1  - 

A1S'3) 

T  _ 
u3 

-  M(A1i2  - 

A2£l} 

M 

=  platform 

mass 

20) 
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APPENDIX  E 


GENERATION  OF  SYSTEM  EQUATIONS  (10-1)  AND  (10-2)  FOR  6 


AND  6 


1.  Approach 

System  equations  (10-1)  and  (10-2)  are  integrated  to  provide 
and  0^  position  data.  In  the  real  system  0^  and  6^  would  be 
the  output  of  the  synchros  on  those  axes. 


The  solution  for  0  and  0  is  obtained  by  using  two  of  the 

x  y 

three  scalar  equations  in  the  vector  equation  (3-4) 


•  A 

9t  £3  + 


(3-4) 


The  process  is  one  of  defining  putting  all  components  of 

A  •  * 

(3-4)  into  a  common  frame  {£>  and  solving  for  0  and  6  as 

•  •* 
functions  of  wpi,  ojfi,  ©T,  @x  and  0y. 

2.  Generate  Components 

First  generate  the  components  in  Eq.  (3-1) 


=  wfl  il  +  "f2  —2  +  uf3  h 


(3-1) 


by  making  use  of  Eq.  (3-2) 


•  A  .  •  A 


£f  =  — 3  +  *p  al  +  *R  —2 


(3-2) 
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Transform  <|>A  n^  into  in"),  using  from  Section  2.0 


{n”  }  =  tci  t^p)  3  tn'  ) 


cosi|jp  sin^p 


•sintpp  cos^p 


Vin^p 


(I 


rA  A, 

n* 


4»acos^ 


Next  add  ^  to  (E-l)  and  transform  to  { }  using  from 

Section  2.0 


{f  >=  [C2(*R)1  in"} 


cos'PR  0 


-siniK 


sin^R  0 


0 

cos<P, 


'I’pCOs ^R  -  '^Asin'i'Rcos'i'p' 


*Asin*p 


^Asin^p 


VosVA# 


^sin'I'o  +  <j».cos<|>Dcos^  . 

p  K  A  K  p 


Finally  add  to  the  result  of  (E-2)  to  complete  the  deter 

R  — c,  - 


mination  of  the  { f }  components  of 


<M-I  | 
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Then 


D2  =  -ajflsineT  +  (Df2cos6T 


(E- 


0  COS8  Sine 

X  X 

0  -sine  cose 

X  X 


wf3  +  eT  'a, 


D2cosex+(eT+a)f3)sinex  [>  (e- 
.-D2sinex+  (eT+00f3)cosex 


•  ^ 

Next  add  6x  to  the  result  of  Eq.  (E-6)  and  transform  into  {£} 
using  from  Section  2.0 


{£}  »  tc3(ey)  j  {£} 

First  redefine  the  last  two  terms  in  (E-6)  as 
y2  =  D2cos0x  +  (0T  +  wf3)sin0x 

y3  =  -D2sin6x  +  +  a)f3^cosex  (E-7 

Then 
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<cn| 


COS0y 

si  no 

y 

0 

( °i+M 

(Dl+^x)cOs6y+y?sin0y ) 

-sin6y 

cos9y 

0 

y2  “ 

“  (D1+®X)  8in6y+y2C°S0y  J 

0 

0 

1 

*  y3  \ 

-3  ) 

Finally  add  6  £  to  the  result  of  (E-8)  to  get 


"Pi  " 

<Dl  +  0x)cos0y 

+  y2sinSy  > 

1 . 

"P2  = 

-  (D1+0X) sin6y 

+  y^cosB 

*2  y  i 

. 

(E-9) 

"p3  = 

y,+0 

y 

J 

4-  Solution  for  9  .  e 

x'  y 

Now  solve  directly  for  6x  and  0y  using  the  third  and  first 
of  Eg.  (E-9) 


6y  ’  "P3  -  *3 


*  (“pl  '  Di0o*8y  ■  y2sin9y)/cosey 


(E-10) 


These  are  system  equations  (10-1)  and  (10-2).  It  is  signif¬ 
icant  to  note  that  these  equations  for  9  and  6  are  functions  of 

•  y  x 

“pl'  ^3 »  0T'  wf2'  uf3#  6x  and  ®t’  Notice  that  does  not 

enter  these  calculations.  We  make  use  of  this  fact  in  Appendix  G. 


APPENDIX  F 

GENERATION  OF  SYSTEM  EQUATIONS  (10-5) ,  (10-6)  AND  (10-7) 

FOLip3-t-ipi-t-ip2 


1.  Overview  of  Process 


Considerable  algebra  is  involved  in  obtaining  Eqs.  (10-5)  and 
(10-6)  due  to  the  need  to  eliminate  unknown  bearing  reaction 
torques  T^/  TpG‘  T^e  Eu^er  equations  (6-2)  and  (6-3)  are 

the  starting  points  with  additional  relations  coming  from  the  con¬ 
straint  equations  in  Section  7.0.  A  number  of  transformations  are 
required  to  obtain  scalar  equations  in  a  common  frame. 


Specific  steps  in  the  process  are: 


a)  Differentiate  constraint  Eqs.  (7-2)  and  (7-3)  to  obtain 

•  • 

new  equations  for  and 

b)  Combine  results  of  step  a)  with  gyro  Euler  Eqs.  (5-2)  and 
(5-3)  to  define  reaction  torques  Ta3  and  T^. 

c)  Perform  transformations  to  define  £  components  of  total 
torque  Tp  in  Eq.  (9-22) . 


d)  Introduce  T  .  components  from  step  c)  into  platform  Euler 
equations  in  Section  6.0,  then  use  results  of  step  b)  to  eliminate 

Ta3  a"d  Tbl' 

e)  Use  oj  2  as  defined  from  velocity  constraints  in  Appendix 

*  •  • 

G  to  eliminate  T^G  leaving  equations  for  and  . 

2.  Differentiate  Constraint  Equations 


Differentiate  constraint  Eqs.  (7-2)  and  (7-3)  to  obtain  new 

•  • 

equations  for  w  _  and  oj.  .  . 

a  3  bi 
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■“bl  '  “plCOSYb  +  “P2sinrb 


Then 

"*3  =  ”^p2sin^a  +  “P3COSYa  +  Ua3 

"bi  =  VCOSYb  +  “P2sinYb  +  utr 

where 

Ua3  "  '“p2YaCOSYa 

Ub3  *  '"plVinYb 

Define  T  .  and  T.  , 

a3  bl 

From  the  Euler  equations  in  Section  5.0 


-  UJp3YasinYa 
+  “p2YbCOSTb 


^3  ’  Ja3  +  W'gS 

”  Jbl  *  Tbl/Igl 


Use  (F-l)  ,  (F-2)  ,  (5-2),  (5-3)  to  eliminate  ua3  and  to 
define  T  and  T,  , 

a  j  hi 


Ta3  *  Ig3t-"p2sin''.  +  "p3cosva  +  ua3  '  Ja3> 


Tbl  “  'gl1  “plcoaTb  *  “p23inYb  +  °bl  -  Jbl)  <F-*> 

4.  Platform  Torque  in  {£}  coordinates 
Next  express 

Ip  *  Tpl  El  *  V  e2  ♦  Tp3  E3  <F-5) 

for  use  in  the  platform  Euler  equations.  Section  6.0. 

Start  v/ith  Eq.  (9-22)  for  T^  and  identify  the  components 
in  that  equation  from  Section  9.0. 


T  -  T 
-p  -ps 


+  -pF  +  -pu  +  -pB  +  -Rp  +  -pc  +  ^pG 


Tps  =  -Kspf0x  3.1  +  0y  &3] 

V  =  -KFPt{VI0x!}  2i  +  {Vl§y|} 

-pu  =  Tul  £l  +  Tu2  ^2  +  Tu3  E3 
-pB  =  TBx  S1  +  T  By  £3 


(9-22) 


(9-15) 


(9-16) 


(9-17) 


(9-18) 
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—pc  "  "Kpc(Yb  3.1  +  Ya  E3}  ’KPI(/Ybdt  ai  +  /Yadt  E3>  <9-20) 

— PG  -  TPG  3-2  <9‘21> 

Rewrite  Eq.  (9-22)  as 

Ip  -  Ti  £i  +  T3  E3  -  la  -  lb  +  TPG  12  *  Ipu  (F-6) 

where 

T1  ■  'V*  -KFp{Sx/l»xl)  +  TBx  -KpcVb  -Kpl'Yb6t 
T3  '  -Kapey  'VV1^11  +  TBy  -Kpl/Yadt 


la  -  Tal  Si  +  Ta3 

A 

*3 

(see 

Eq. 

(9-7) ) 

lb  =  Tbl  -1  +  Tb3 

A 

—3 

(see 

Eq. 

(9-14)) 

Now  start  a  series  of  transformations  to  put  all  components  of 
Eq.  (F-6)  into  the  {£}  frame. 

First  transform  Ta  =  _Tai  fL).  "Ta3  £3  into  ^E'  using,  from 


Section  2,0 


-  (Cx 

(Ya) ]T(a} 

] 

0 

0 

( 'Tal ) 

i"Tai  1 

0 

c°SYa 

-sinYa 

° 

-  < 

^a3sinYa  | 

0 

sinY  _ 

a 

c°sYa 

V  -T  ) 

v  xa3  a 
a 

-T^jCOBYa  > 

Next  transform  Tb  =  -Tbl  -Tb3  -3  into  ^  using  from 
Section  2.0 


{£)  =  [C,(Y.)]T{b} 


cosyb  -sinYb  0 


smY, 


COSYb  0 


-T 

0 

,-T 


bl 


b3  a 


-Tbi  cosYb 
~Tbl  sinYb 


-T, 


b3 


(F-8) 


A  A  A 

Next  transform  +  T^G  ^2  * nto  '•E-f  usin9  from  Section  2.0 


{£}  =  [C3(6y)]  {£} 
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cos  8 

sin8 

0 

/  T,  \ 

y 

y 

i  1 

-sin0 

COS0 

0 

y 

y 

)  PG( 

0 

0 

l 

v  o  ) 

!1 , COS  9 

1  y 

-TlSin6y 

0 


+  TpGsin9 
+  T  _COS0 


y 

y 


Now  sum  all  of  the  {£>  components  in  (F-7) ,  (F-8) ,  (F-9)  with 
T3  £3  in  (F-6)  and  Tpu  as  defined  in  (9-17)  to  obtain  the  Tpi 
components  in  (F-5) . 


T 

T 

T 


Pi 

P2 

P3 


"Tal  "TblcosYb  +  Tlcos0y  +  TPGsin6y  + 
Ta38inya  "TblsinYb  "Tlsin6y  +  TPGcose 
-Ta3COSya  -Tb3  +  T3  +  Tu3 


5.  Put  Terms  into  Euler  Equations 

At  this  point  combine  the  definitions  of  T  ,  and  T.  ,  in 

^  J  D<L 

(F-3)  and  (F-4)  with  the  {j>}  coordinates  of  Tp  in  (F-10)  into 
the  platform  Euler  equations  in  Section  6.0. 

The  Euler  equations  are : 


wpl  =  Tpl/;tpl 
up2  =  Tp2/'Ip2 


U'P3  =  Tp3/Ip3 


Using  Eqs.  (F-3)  and  (F-4)  write  Ta3  and  as 


Ta3  “  rl“p2  +  r2"p3  +  r3 


(F-ll) 


Tbl  =  SlWpl  +  S2“P2  +  s3 


(P-12) 


where 


rl  - 

-1g3sinYa 

S1  = 

1 glCOSY 

ro 

II 

lg3c°3^ 

S2  = 

IglsinY 

r3  = 

:g3<Ua3  ‘Ja3] 

S3  = 

Jgl (Ubl 

Use  (F-ll)  and  (F-12)  to  eliminate  Ta3  and  Tfal  in  Eg.  (F-10)  and 
substitute  the  result  into  Eqs.  (6-1),  (6-2),  (6-3). 


Ipla)pl  ~  ”Tal  “COSYb  ^l^pl  +  s2“p2  +  s3] 


+  TlCos0y  +  Tul  +  TpGsin8y 


( F-l 3) 


Ip2wp2  =  sinVrlwP2  +  r2u,p3  +  r3> 


-  sir.Yb(Slu,pl  +  s2*p2  +  s3) 


-  T^sin3y  +  ru2  +  TpGcos6y 


(F-14 ) 


(F-15) 


Xp3wp3  =  ■COSYa(r1u)p2  +  r2^p3  +  r3}  “Tb3  +  T3  +  TU3 

6*  Elimination  of  T  and  Solutions 

Eliminate  TpQ  by  combining  Eqs.  (F-13)  and  (F-14)  to  obtain: 


“pld5  +  “p2d6  +  “P3d7  "  d8 


(F-16) 


where 


*lslnyb  tan6y  _Ipi  “S^cosy^ 


(s2smYb  -rlSinYa  +  Ip2)  tan0y  -s2cosyb 


=  -r,siny_  tar.e 

^  a  y 


Tal  +  83COSYb  -V°sey  -Tul 
+  (r3sinYa  -s3sinYb  -Tj.sinBy  +  tu2)  tanb 


Write  Eq.  (F-15)  as: 


“P3  =  d20“p2  *  d2l“p3  *  d22 


(F-17 ) 


where 


120  =  -(rlCosYa)/Ip3 


d21  =  -(r2COSYa)/Ip3 

d22  =  (-r3cosYa  -Tb3  +  T3  +  Tu3)/Ip3 


This  leaves  two  equations  ((F-16)  and  (F-17))  in  three 
•  «  • 

unknowns,  w  ,  ^3.  Obtain  a  third  equation  from  the 

velocity  constraints  due  to  the  gimballing  that  is  determined 
in  Appendix  G.  The  result  is; 


U) 


P2 


=  -w  .  tanQ,,  -d,  osin0..  + 
pi  y  10  y 


‘13 


(G-3) 


where  d^g  and  d^  are  defined  in  Appendix  G 

The  solution  of  this  set  of  equations  ((F-16),  (F-17)), 
(G-3)  is: 


“  _  UH 

^  -  an 


(F-18) 


V  =  -  3^  tan6y  “d10ainey  +  d13 


(F-19) 


d2QUlp2  +  d22 


P3 - 


(F- 20) 


21 


where  d^  =  dg  +  (d13  -dlosin0y)  (-dfi  - 


d7^20 

d!2  “  d5  +  taney<-d6  '  rajj) 
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APPENDIX  G 


GENERATION  OP  u>_0  FROM  VELOCITY  CONSTRAINTS 

- p2 - 

This  appendix  develops  <!)p2  from  velocity  constraints 
imposed  by  the  gimballing  configuration  for  use  in  Appendix  F 
as  the  third  of  the  three  platform  system  equations. 

The  process  here  is  to  use  Eq.  (E-9)  for  <*>p2  and  differen¬ 
tiate.  Additional  relations  are  obtained  from  Appendix  E,  noting 
that  Gx  and  0y  are  independent  of  as  indicated  by  Eq.  (E-10). 

«p 2  =  “(Di  +  ®x)sin6y  +  y2cos0y  (E-9) 


where 

D1  " 

uflcos0T  +  uf2sin0T 

o 

NJ 

II 

-uflsin0T  +  u>f2cos9T 

II 

IN 

>i 

D2cos0x  +  (®T  +  wf3)sin0x 

Differentiating  Eq.  (E-9)  produces 


Up 2  =  - (dx  +  ex)siney  -ey(D1  +  ex)cosey 


+  y_cos6,,  -y_9  sin0 


(3-1 


We  now  require  relations  for  9^,  D^»  y2.  From  Appendix  E, 
Eq.  (E-10 ) 


9„  «  (a) 


Pi 


-D^cosSy 


-y2sin6y)/cos6y 


(E-10) 


Differentiating  Eq.  (E-12)  produces 


where 


9x  ~  cos6y  +  d10 


<G-2) 


d,  „  =  (-DtCOsS^  +  D,  0.,  sin§  -y2sin6  -y^  cose  ) 


‘10 


'iuy 


-1 


(cos  e  )  +  e  <«  -D^cos6  -y2sin0  ) 


_  2 

cos  6  sin6 


y'  y  pi 
ysiI,ey 


Substitute  Eq.  (G-2)  into  (G— 1 )  to  obtain  the  solution 


““pltan0y  -d10sin9y  +  d 


13 


where 


-Engine  -eyCDj^  +  0x)cos6y 
+  y2cos0y  -y29ysin0y 


(G-3) 
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We  define  D^,  D2  and  y2  by  differentiating  the  equations  under 
(E-9)  above: 

=  ^flcos0T  -wfleTsineT  +  uf2sineT  +  wf20Tcos0T  ( 

°2  =  ■^f1sin0T  -wfl81cosQT  +  ujf2cos0T  -uf20Tsin0T  ( 

y2  =  D2cos0x  -D20xsin0x 

+  (0T  +  ^f3)sin0x  +  0X(0T  +  caf3)cos6x  ( 

We  define  the  terms  by  differentiating  Eqs.  (E-3)  for 
in  Appendix  E. 


wfl  *  %cos'pr  *^p^Rsin^R  -$Asin^RcosiJ/p  -ii;AiI-Rccs*Rcos^p 


+  <P.  i^sin^sinij; 

/>  P  I\  P 


(G-7) 


Wf  2  =  *R  +  Vin^p  +  Vp003^ 


(G-8) 


wf3  =  ^psin^R  +  ^p^Rcosl^R  +  Vo^rCOS^p 


■*.^Rsin^  cosil)  -KY  cos<i>0sini|> 


( G—  9 ) 


APPENDIX  H 


COMPUTER  PROGRAMS 

INTRODUCTION 

The  Fortran  computer  programs  contain  the  inputs,  torques 
and  system  equations  defined  in  this  report  and  computes  the 
system  trajectory  by  use  of  Runge  Kutta  integration. 


PROGRAMS  AND 

SUBROUTINES 

MT21D: 

Main  program 

MTRKl : 

4-cycle  Runge  Kutta  integration 

MT22: 

Ship  motion  and  coordinate  transformation 
for  command  inputs 

MTl 9B : 

Torques 

MT20B: 

State  equations 

PLOT: 

Library  plotting  routine 

Figure  H-l  is  an  overall  block  representation  of  the  program. 
The  listing  of  the  program  is  attached. 
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STORE  FOR 
PL0TTIN6 


n  -  * 

»•  * 

U  « 

X 

ft  x  * 

»ft  ~ 

n  *•  a  ft  * 

X  X 

X 

0  3’ 

n  o  ft 

ft  ft  o  ft  Ck  ft 

€  X 

3 

X 

.J 

V  Q  Q  -  ft  Aj  O 

ft  3 

ft  - 

(L  -  ► 

*  -  - 

ft  .  .ft  .  .  . 

«  ft 

—  \ 

s 

ynw 

A  ft  ft  ft 

ft.  W  - 

ft  O  ^  ft 

r> 

ft 

~  c 

•-  ft  r- 

.J 

ft 

•  <*  tff ft 

• 

O  -  -  ft 

ft  ft 

3  ft  X 

~  o 

►- 

(■»  -  ft 

A  T«  ft  A  &  A  • 

A 

X  ft  V  3 

ft  — 

ft  o 

m  \  o  ■  ft  *  ft 

ft  ft  • 

ft 

«  ft  «  ft 

ft  « 

X  X  ft  « 

ft  X 

■  CJ  — 

a  -  ft  -f  (MftQ 

v  a  ft  Q  • 

ft  a 

ft  •  X  ft  ft  M 

m  S  «N 

•  *0 
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NOMENCLATURE 


K 


FG 


r  P 
KPC 
KPI 
KSG 


SP 


* 


total  linear  acceleration  vector  (App.  D)  • 

A 

Ei  components  of  A 

acceleration  term  due  to  gravity 

fore-aft  acceleration 

athwartship  acceleration 

centripetal  acceleration  due  to  turn 

force  applied  to  platform  at  support  point  (App.  D) 

height  above  center  of  roll 

gyro  inertia  diadic 

a,  and  £.  principal  inertias  of  I 

platform  inertia  diadic 

Ei  principal  inertias  of  I 


control  gain  on  'A'  gyro  for  Y  axis  error 
control  gain  on  ’b'  gyro  for  X  axis  error 
gyro  friction  torque  magnitude 


P^-atf°rm  friction  torque  magnitude 

Isr  gain  for  X  and  Y  axis  torguers 
integrator  control  gain  for  X  and  Y  axis  torguers 
gyro  spring  gradient 
platform  spring  gradient 
torque  vector  due  to  unbalance 


(„)  denotes  a  vector 

subscript  i  applies  to  all  integers  except  for  d 


. ^Ti'|fr^,-i«ii|iP""Tif»r 


TaS  =  spring  torque  acting  on  'A'  gyro 


— au 

*b 

Tbi 

-bB 

-bF 

-bS 

2bu 


Bx 


By 

T 

-ca 

T  . 
-cb 


unbalance  torque  acting  on  'A'  gyro 
total  torque  vector  acting  on  'B'  gyro 

A 

b^  components  of 

bias  torque  acting  on  'B'  gyro 

friction  torque  acting  on  'B'  gyro 

spring  torque  acting  on  'B'  gyro 

unbalance  torque  acting  on  '  b’  gyro 

x  component  of  bias  torque  acting  on  platform 

y  component  of  bias  torque  acting  on  platform 

control  torque  applied  to  'A'  gyro 

control  torque  applied  to  'B'  gyro 


83 


ok . . . . . 


T 

“P 

= 

torque  vector  acting  on  platform 

T  . 
PJ- 

- 

components  of 

T 

-pB 

= 

bias  torque  vector  acting  on  platform 

T 

-pc 

= 

control  torque  acting  on  platform 

T 

~PF 

= 

friction  torque  acting  on  platform 

T  „ 
-Pw 

= 

gimbal  bearing  reaction  torque  on  platform 

T 

PG 

= 

magnitude  of  TpG 

T 

-ps 

= 

spring  torque  acting  on  platform 

T 

-pu 

- 

unbalance  tcrque  acting  on  platform 

T 

-Ra 

= 

pivot  bearing  reaction  torque  on  'A'  gyro 

T 

-Rb 

= 

pivot  bearing  reaction  torque  on  'B'  gyro 

T  . 
U1 

= 

A 

components  of  T 

V 

= 

ship's  speed 

GREEK  LETTERS 

aA 

- 

satellite  azimuth  ephemeris 

aE 

= 

satellite  elevation  ephemeris 

Ya 

= 

r  Ai 

ta;  frame  rotation  angle  with  respect 

to  { 

Yb 

= 

.  A 

lb)  frame  rotation  angle  with  respect 

to  f 

*A 

= 

ship's  azimuth 

- 

heel  angle  of  deck 

"p 

= 

pitch  angle  of  deck 

Ip 

po 

= 

amplitude  of  harmonic  pitch  motion 

= 

roll  angle  of  deck 
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ro>  ra> 


nil 


*R  +  *H 


=  amplitude  of  harmonic  roll  motion 
=  ship  flexure  angle 
=  train  axis  angular  displacement 
=  X  axis  angular  displacement 
=  command  value  for  0^ 

=  Y  axis  angular  displacement 
=  command  value  for  0^ 

A 

=  angular  velocity  of  {a}  frame 

A 

=  a.  components  of  to 
*“i  —a 

A 

=  angular  velocity  of  tb>  frame 

A 

=  components  of 

=  angular  velocity  of  local  deck  frame  {£} 

A 

=  components  of  ajf 

=  natural  frequency  of  train  axis  controller 
=  angular  velocity  of  {£} 

=  frequency  of  ship's  pitching  motion 
=  components  of 

=  frequency  of  ship's  rolling  motion 
=  if'A  =  rate  of  change  of  ship's  heading 
=  angular  velocity  of  'A'  rotor 
=  constant  'A'  rotor  spin  speed 
=  angular  velocity  of  'B*  rotor 
=  constant  'B'  rotor  spin  speed 
=  train  axis  control  damping  factor 
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TERMS  IN  SOLUTIONS 


TERM 


di  <A 

di  (i 

D.  . 
l 

Jai 

Jbi 
r .  . 

i 

S  . 
i 

t  .  . 
l 

Ua3 
°bl 
yi  ‘ 


=  5,6,7,8,11,12,20,21,22) .  .  . 


=  10,13) 


WHERE  DEFINED 
Appendix  F. 6 
Appendix  G 
Appendix  E 
Section  5.  0 
Section  5.  0 
Appendix  5.F 
Appendix  F. 5 
Appendix  C 
Appendix  F. 2 
Appendix  F.2 
Appendix  E 
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